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Abstract 


A live problem in modern day robotics is to construct highly dextrous 
manipulators to be used for maintenance purposes. Hyper-redundant ma- 
nipulators provide one solution to this problem. 

Manipulators in which the actuated degrees of freedom exceeds the min- 
imal number required to perform a particular task are termed as ‘redundant 
inanipiilators’. Ilyper-redundant manipulators arc roduiidant manipiilator.s 
with a large degree of redundancy. Because of their highly articulated struc- 
tures, these robots arc well suited for operation in highly constrained envi- 
ronments. Such high redundancy also helps in obstacle avoidance, singularity 
avoidance, workspace enhancement and performance optimization. 

For designing a hyper-redundant manipulator, an important step is to 
plan its path. Since hyper-redundant manipulators have a large number of 
degrees of freedom. Configuration space (C-space) based path planning is a 
promising prospect. 

For C-space based path planning, an exhaustive description of the C-space 
is a pre-requisite. In addition to this, to find a feasible path, all candidate 
solutions are required to be known. The aim of this work is to provide the 
above mentioned inputs for path planning and synthesis. In this work, a way 
to map obstacles from Cartesian space to C-space is presented. An attempt 
is also made to represent different C-obstacIes separately. Finally, a way to 
compute the inverse kinematics solutions is presented. The treatment is done 
for both 2-D and 3-D cases. 



Chapter 1 
Introduction 


1.1 Hyper- Redundant Manipulators 

The -word redundant is used in the context of robotic manipulators to indicate 
that the number of actuated degrees of freedom exceeds the minimal number 
required to perform a particular task. For instance, a manipulator required to 
position and orient an object in space needs six actuated degrees of freedom 
and so a manipulator with seven or more degrees of freedom is redundant 
with respect to this task. “Hyper-Redundant” manipulators are redundant 
manipulators with a very large degree of redundancy. These manipulators 
are analogous in morphology and operation to ‘snakes’, ‘elephant trunks’ 
or Tentacles’. Because of their highly articulated structures, these robots 
are well suited for operation in highly constrained emironments and can be 
designed to have greater robustness with respect to mechanical failure than 
manipulators with a low degree of redundancy. Such high redundancy also 
helps in obstacle avoidance, singularity avoidance, workspace enhancement, 
performance optimization and improvement in reliability leading to safer 
operational situations. 

To date, h3rper-redundant manipulators have remained largely a labora- 
tory" curiosity. There are a number of reasons for this. 

• standard kinematic techniques have not been particularly efficient or 
w'ell-suited to the needs of hy'per-redundant robot task modeling. 

• the mechanical d^ign and implementation of hyper-redundant robots 
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has been perceived as unnecessarily complex. 


1.2 Problem of Path Planning 

Many times in the field of robotics we come across situations w'here we have 
a manipulator fixed inside a workcell. There axe a number of obstacles of 
various shapes and azes located at different places inside the workcell and 
with different orientations. The problem of path planning is that we are 
given a start point and a goal point; the end effector of the robot has to be 
moved in such a way that while moving from the start point to the goal point 
it should not strike any obstacle or any workcell wall or any link of itself. 
Thus we come to the important requisites of a good path, which axe 

• It should avoid obstacles. 

• It should avoid workceU boundaries. 

• It should avoid self-intersection of the manipulator. 

A path that guarantees aU the above three can be taken to be a feasible 
path. 

Now, there are numerous ways to tackle this path planning problem. 
One way is to do the path planning in Cartesian space itself. But for hyper- 
redundant manipulators which have a large number of degrees of freedom, 
it is quite cumbersome to do it in Cartesian space. Another way to attack 
this problem is to do the planning in Configuration space (C-space). In this 
approach, the obstacles and the workcell boundaries are mapped from the 
Cartesian space to the Configuration space and a path is searched avoiding 
the C-space obstacles. 

1.3 Inverse Kinematics Problem 

Given the position and orientation of the end-effector of a manipulator, the 
inverse kinematics problem is the search for a suitable set of joint variables 
that cause the end-effector to take that particular position and orientation in 
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the workspace. For a hyper-redundant manipulator having a large number 
of degrees of freedom tie number of solutions is infinite. Since the number 
of joint variables is quite large in this case, analytical methods prove to be 
inadequate. Optimization techniques, especially genetic algorithms (GAs), 
provide one w'ay of finding a large number of these solutions. 

1.4 Literature Review 

Research strictly addressing the problem of path planning in C-space is fairly 
recent, although this idea of planning the path in C-space was introduced by 
Lozano-Perez [1] way teick in 1983. After that, there has been some research 
in this field, but most efforts get bogged down by the complexity of the 
problem. First of all, it is considered very difficult to generate the C-space 
obstacles precisely. Even when there is a precise description of the C-space, 
most researchers trj' to find a path by searching in the n-dimensional C-space. 
This exercise becomes quite complex for hyper-redundant manipulators. In 
fact, because of its complexity, not much work has been reported on C-space 
based path planning hyper-redundant manipulators. 

Most of the first planners were based on extensive searches in the configu- 
ration space (R .A. Brooks and T Lozano-Perez [2]). When used in spaces with 
more than three dimaasions, these approaches showed that it is practically 
impossible to explore all the space. Potential field techniques are thought 
of for on-line use (Khatib [3]), but they have one important drawback; the 
generation of local minima. Barxaquand et al [4] describe numerical potential 
fields free of local minima. How^ever, these potentials require an exploration 
of the entire configuration space. This method has been successfully used in 
robots with 1^ than four degrees of freedom. 

Ma and Kyiono [5] provide an obstacle avoidance scheme for planar hyper- 
redundant manipulators. It is based on analysis in the defined posture space 
where three parameteis axe used to determine the hyper-redundant manip- 
ulator configuration. .Another wmrk by KavTaki and Latombe [6] proposes a 
pre-processing stage and a planning stage. Pre-processing generates a net- 
work of collision free nodes. Planning then connects any given initial and 
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final configurations of the robot to two nodes of the network and computes 
a path through the network between these two nodes. Lengyel et al [7] in- 
troduce a planner that uses standard graphics hardware to rasterize C-space 
otetacles into a series of bitmap slices and then uses dynamic programming 
to create a navigation function and to calculate paths in this rasterized space. 

Eari and Torres [8] describe a heuristic approach to 2-D path planning 
for a rigid mobEe body in C-space. Bajaj and Kim [9] present an algebraic 
algorithm to generate C-space obstacle boundaries where the obstacles are 
given by patches of algebraic surfaces. 

Considerable work has been done in inverse kinematics solutions for ma- 
nipulators in general but not much on hyper-redundant manipulators in par- 
ticular. A cl(»ed-form solution of the inverse kinematics of a redundant 
manipulator is in general not available. One method proposed by Gravagne 
and Walker [10] approaches inverse kinematics for a planar hyper-redundant 
manipulator hy decomposition into either a natural or a wavelet basis. Xu 
and Nechyba [11] solve the inverse kinematics problem using fuzzy logic. 

1.5 Scope of Work 

This work is divided into two parts. The first part of the work is concerned 
with obstacle mapping. The obstacles comprise of: 

• Physical obstacles present inside the workceE. 

• WorkceE boundaries. 

• Self-intersection of the manipulator. 

These obstacles are mapped from Cartesian space to Configuration space. 
The scene after the mapping is that we have a host of points in the C-space 
of the manipulator; some are obstacle points, some are boundary points, 
some are seE-mtersection points and the rest are ‘free’ points. Free points 
represent those configurations of the manipulator where it does not hit any 
kind of obstacle. A feasible path has to pass through these free points. An 
attempt is also made to get separate non-overlapping C-obstacles. 
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The second part of the work deals with performing inverse kinematics of 
the hj'per-redundant manipulator using GA. Since the number of solutions 
are infinite, the function space is highly multimodal. Here we use the concept 
of ‘niching and speciation’ to zero-in on solutions lying on maximum number 
of peaks. This gives us ‘solution clusters’ which reflect a wide variety of 
inverse kinematic solutions. 

1.0.1 Importance 

The current work is the first step of a larger project, which is to realize and de- 
velop a robotic system by using redundancy to work in an environment with 
target locations difficult to access. A large number of tasks m the routine in- 
spection and maintenaince of plants consist of quite simple tasks that can be 
performed by robots.. This when compounded with a situation of the plant 
being inhospitable for human beings due to high temperature, toxic or ra- 
dioactive substances makes an automated or robotic maintenance/inspection 
imperative. However the situation gets complicated as many of the inspec- 
tion sites in the plant are in locations that are difficult to access manually as 
well as by a robot. In such a scenario, the need is to devise a manipulator 
with a large number of degrees of freedom so that the inspection sites can be 
accessed in a serpentine fashion rather than in a conventional anthropomor- 
phic manner. This calls for a hyper-redundant manipulator, which indeed 
comes with its own theoretical and practical challenges. In the present work, 
the analysis of such ‘complicated’ workcells is addressed, the results of which 
viH be vital for the next phases, namely path planning and design. 

1 . 6 Assumptions 

• The manipulator comprise of links connected in series through revolute 
or prismatic joints. 

• The workcell considered in the problem is in the form of a rectangular 
parallelopiped. 


5 



• The links of the manipulator are circulax in cross section and taper 
along their length. 

• Obstacles comprise of simple primitives like parallelopipeds and cylin- 
ders. 

Except for the first one, all assumptions have been made for the current 
implementation only and, in general, do not affect tie problem formulation. 

1.7 Organization of the Thesis 

• Chapter 2 presents the way in which the workcell, physical obstacles 
and the manipulator are modeled for this work. 

• Chapter 3 describes the complete algorithm used for performing obsta- 
cle mapping and getting C-obstacles. 

• Chapter 4 provides an insight into the domain of genetic algorithms 
and describes how to use them to get inverse Mnematics solutions. 

• Chapter 5 gives the various kinds of results obtained for obstacle map- 
ping and inverse kinematics. 

• Chapter 6 summarizes the whole work and proposes its future scope. 

• Appendices A and B summarize some well-kncfwn background material 
for easy reference, while appendices C and D are meant to form a handy 
reference for the program developed. 
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Chapter 2 

Workcell and Manipulator 
Modeling 


The Sxst step to proceed towards obstacle mapping is to model the workcell 
and ihe manipulator in a convenient manner. 

2.1 Workcell Modeling 

The workcell consists of the room and the physical obstacles which are located 
inside it. 

2.1.1 Room 

The room we have in hand is in the shape of a rectangular parallelopiped (Fig 
2.1). The three dimensions: length, breadth and height need to be specified 
to have its complete description. A Universal frame ({U} frame) is attached 
to its far-bottom-left comer. All locations inside the room are described vdth 
respect to this {U} frame. 

2.1.2 Obstacles 

The obstacles are modeled as physical objects which are made up of simple 
primitives. A frame is attached to each obstacle. The position and orienta- 
tion of the obstacle inside the room is given by specifying the position and 
orientation of thfe frame with respect to the {U} frame. 
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Figure 2.1: Rx)om with {U} Frame 


Position is specified by gi\’ing the co-ordinates (a:, y. z) of the origin of 
the obstacle &ame in the {U} fiame. 

Orientation is specified by giving the three angles a, 3, and 7 where, 

7 = angle of rotation about the X-axis of the {U} frame to get the obstacle 
frame 

3 = angle of rotation about the Y-axis of the {U} frame to get the obstacle 
frame 

a = angle of rotation about the Z-axis of the {U} frame to get the obstacle 
frame 

The abow information gives ns data to construct the transformation ma- 
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Figure 2.2; Obstacle Frame Description 

trix describing the obstacle frame with respect to the {U} frame. 

cacP cas^s'f — sacj caspcj -i- sa:S 7 x ' 
sac/3 sasPsj + cac 7 sasScrf — cols^ y 

—sB CpSJ CpCTf z 

0 0 0 1 . 

Any point (vector) in the obstacle frame w'hen pre-multiplied with this trans- 
formation matrix will give co-ordinates of that point in the {U} frame. 

The obstacles are considered to be made of tw'O kinds of primitives: 

Parallelepiped w'hich is in the form of a box. 

Cylindrical whidi ranges from a solid cylinder to a sector of a hollow cylin- 
der. 


U rp 

obs-^ 
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Any other shape of an obstacle needs to be constructed (in the current im- 
plementation) from primitives of these two kinck. A local frame is attached 
to each of the primitive called the primitive frame (Fig 2.2). Its complete 
description inside the obstacle is given by specifying the position and orien- 
tation of this primitive frame with respect to the obstacle frame to get the 
transformation matrix Thus any point inside the primitive can be 

expressed in the obstacle frame. 

2.2 Manipulator Modeling 

The manipulator is modeled as a set of links connected in a chain. It can be 
thought of as a set of bodies placed one after the other to form a long jointed 
arm. The links considered are of circular cross section and taper along the 
length. 

Due to actuation considerations, manipulators axe generally constructed 
from joints which exhibit just one degree of freedom. Most manipulators 
have revolute, joints or have sliding joints called prismatic joints. Our 
manipulator consists of both these kinds of joints. 
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To describe the manipulator inside the room, a frame called {0} frame 
is attached to the base of the manipulator. The position and orientation of 
this base frame is described by the transformation matrix qT constructed 
as described above. 

To get the description of all links of the manipulator, local frames are 
attached to each of them^ (Fig 2.3). The description of these hnk frames 
vith respect to the preceding ones is given by the Dena\’it-Hartenberg (D- 
H) parameters. Using these D-H parameters we can construct link to link 
transformation matrices \~^T. 

The four D-H parameters are link twist link length (ci-i), link 

oSset (di) and joint angle {9i). Of these, for a particular joint, three are fixed 
and one is variable. For a revolute joint, aij-i, Oj-i and dj axe fixed while 6i 
is the joint \'ariable. For a prismatic joint, Oii_i, a,-! and 9i are fixed while 
dj is the joint variable. 

Link transformation is the transformation which defines frame {z}, at- 
tached to the i-th link, relative to the frame {i — 1}, attached to the (z — 1)- 
th link. For any given robot this transformation is a function of only one 
variable, the other three parameters being fixed by mechanical design. This 
transformation matrix is given by 

c9i —s9i 0 Oi-i ■ 

i-ij, _ s9icai^i c9icai_i — soj-i -soj-idj 

‘ ~ s9isai^i c9isai-i ccti-i caj_idj 

0 0 0 1 . 

We can represent any link fi^me {n} vith respect to the base frame {0} 
by applying the following transformation 

Q rp Qrp Irn 2rp 

n ^ 

Since the description of {0} frame is knowm with respect to {U} frame, we 
can get the description of any frame n with respect to {U} frame as 

U rp Urp 0 rp 

^For frame assignment, refer Craig [12], a brief description is also included in Appendix 
B. 
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Thus the complete description of the manipulator is known inside the work- 
cell. 
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Chapter 3 

Obstacle Mapping 


There are various ways to plan paths for manipulators which are free of any 
kind of obstacles. One way is to do it in Cartesian space and the other in 
Configuration space. 

3.1 Cartesian Space 

Here we have a description of the workcell in the form of 3-D objects. Some of 
the methods which work here are the Potential Field Method and Sensor based 
path planning. The potential field method suffers from local minima and it 
is difficult to formulate a potential function which is free of local minima. 
Sensor based path planning employs considerable electronics component. For 
hyper-redundant manipulators the earlier method is prohibitively complex 
and the latter one is resource-dependent. 

3.2 Configuration Space 

The C-space approach due to Lozano-Perez [1] is a relatively new method. 
Here, we map the whole workcell of the hyper-redundant robot into its C- 
space. After the mapping we have the description of the C-space obstacles. 
Thereafter the C-space can be searched for a feasible path. This mapping 
for h 3 'per-redundant manipulators does not exist as yet and this is the first 
attempt to accomplish it. 
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Once the mapping is complete, we have a description of the C-space of the 
hyper-redundant manipulator in the form of discrete points^. These points 
belong to any one of the following tjrpes. (See Fig 3.1) 


Boundary Self-mteiseajc| Points 



Figure 3.1: C-space Points for a Manipulator 


Obstacle points These points are generated when any link of the manip- 
ulator collides wdth the physical obstacle present inside the workspace 
of the robot. They actually represent those configurations of the robot 
when it hits an obstacle. 

Boundary points These are generated when the manipulator collides with 
the workcell boundary. They are those manipulator configurations 
when it hits the workcell boundary. 

^Points in C-space are actually configurations that the manipulator takes in the 3-D 
Cartesian space. 
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Self-intersection points Apart from the above two types of C-space ob- 
stacles, a third type is this one. It represents those configurations of the 
manipulator when any link of it has collided with any other link of it- 
self. Such C-space obstacles are not directly ‘visible’ in Cartesian space 
but they come into play when the robot takes different configurations. 

Free points As the name indicates, these points represent those configu- 
rations of the hyper-redundant manipulator when it does not hit any 
obstacle or any link of itself. A feasible path has to pass through such 
free points. 

3.3 Mapping 

ifapping of obstacles from Cartesian space to Configuration space and iden- 
nfring separate C-obstades forms the major part of this work. This mapping 
is basically performed by generating a large number of configurations of the 
h}-per-redundant manipulator and computing the intersections wdth the ob- 
stacles. 

3.3.1 METHODOLOGY 

The methodology can be enumerated in the following steps. 

1. Input workceU in (k 11 decomposed form. 

2. Input manipulator using I>-H parameters. 

3. Generate a large number of configurations of the manipulator. 

4. Compute intersections of the manipulator body with all kinds of ob- 
stacles. 

5. Store configurations appropriately. 

6. Identify separate C-obstacles. 
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3.3.2 Workcell input 

For this work, the workcell that has heen considered is in the form of a 
rectangular room^. The workcell consists of a number of obstacles located at 
various locations inside it (Fig 3.2). 

ROOM 

The dimensions of the room (length, height, breadth) are input by the user. 
Thereafter the room is divided into discrete equal-sized cubic cells (Fig 3.3). 
The number of cells depends on a resolution factor. A value of this factor 
greater than 1 increases the resolution of this cubic discretization, e.g. if 
factor = 2, the number of cells in each direction becomes double the value of 
the dimension in that direction. 

Once the dimensions are input, the cells on the boundary of this room 
are flagged as boundary. The Universal frame ({U} frame) is attached to 
the far-bottom-left comer of this room. X-axis is from left to right, Y-axis is 
from bottom to top and Z-axis points right at the viewer. 

OBSTACLES 

The obstacles are basically made of two kinds of primitives: parallelopiped 
and cylindrical. For the parallelopiped primitive, the length, height and 
breadth are input along with its description with respect to the obstacle 
frame. For the cylindrical primitive, its inner and outer radii, start and end 
angles are input along with its length. Its description with respect to the 
obstacle frame is also input. 

For each obstacle input, the description of the primitives is provided wuth 

respect to the local frame attached to the obstacle. The primitives can be 

located at various places inside the obstacle and at different orientations. The 

description of the obstacle is input in the form of position and orientation of 

its local frame with respect to the {U} frame. 

^ Arbitrary' shape of workceil can be implemented by defi n i n g obstacles which touch the 
bocmdaiy and flagging cells belonging to these otetacles as boundary cells. 
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Once the complete description of one obstacle is known, the cells belong- 
ing to the obstacle are flagged as obsfl]. Similarly, other obstacles are fed 
and (mrresponding cells are tagged as obs[2], obs[3] etc. The remaining cells 
i.e. cells not belonging to either the boundary or any obstacle are flagged as 
empty. 

3.3.3 Manipulator input 

The manipulator is input in the form of D-H parameters. The four D-H 
parameters are link twist (oj-i), link length (ai_i), link offset (di) and joint 
angle {6i). Of these, for a particular joint, three are fixed and one is variable. 
For a revolute joint, aj-i, Oj-i and d,- are fixed while 9i is the joint variable. 
For a prismatic joint, ai-i, a,-! and are fixed while di is the joint variable. 
For each joint, the low’er and upper limits of the joint variable are also 
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Figure 3.3: Cell Decomposition of Workcell Room 

input. The whole manipulator is constructed by using this set of link param- 
eters and a ‘generated’ joint variable. If a link is not along any of the X, Y or 
Z axes of its local frame, the user has to specify a set of points representing 
the ‘mid-line’ curve of the link. 

The links considered in this work are of circular cross section and taper 
along thdr length. Physical lengths of the links are also input^. The user 
also specifies whether frame is located on the top or bottom of the link^. 
In addition to this information, the user also gives the base radius of the 
first link and the radius reduction ratio Flagging of cells, as belonging to 
manipulator, is done later when configurations are generated. 

^This is required in the case when two succesive links share the same joint axis and 
local frame of one is located at its base and of the other at its top. In such case, if the 
phj-sical length of the first link is not ^ven, we lose the information where that link ends 
and the other begins. 

■*This is to ascertain the direction in which the link is to be grown. 

®This value determines to what extent the radius will reduce along the length of the 
link, i.e. it gives the taper. 
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The description of the fixed hast frame attacLed to the base of the first 
link is also input from the user. We call it the {0} frame. 

3.3.4 Generating configurations 

After the w'orkcell and the manipulator have beer input, a large number of 
configurations of the hyper-redundant manipulator are generated. This is 
done by assigning different values to joint variables of all the joints. The 
user inputs a value for the number of ‘steps’. Depending on this value, a 
fixed number of divisions are made between the specified lower and upper 
limits of the joint variables. Each joint variable is made to take all the values 
at these di\Tsions, for each new value of its previous joint variable. In this 
way, the workspace of the robot is explored exhaustively. 



Figure 3.4: Link to Link Frame Transformations 
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3.3.5 Computing intersections 

Fox each configuration generated by the above process, it is checked whether 
the manipulator body intersects with any of the obstacles. This is done 
by computing intersections of the manipulator with the workcell boundary, 
workcell obstacles and with its own links. 

Refer Figure 3.4. Here the {U} frame has been shown attached to the 
far-bottom-left comer of the room. The {0} frame is the one attached to the 
base of the first link. A few intermediate links and the end links have also 
been shown with their local frames attached. 

Link transformations 

Fox any given robot the link to link transformation matrix is given by 

cBi —s9i 0 Cj-i ' 

s6icai-i — soi-i —sai-idi 

s9isai-i cdiscti^i cai-i coi-idi 

0 0 0 1 . 

Once the description of any link frame with respect to its previous link firame 
is available, we can represent any link frame {n} with respect to the base 
frame {0} by applying the following transformation 

0 /yj Orp Irp 2rjt N—tnn 

Since the de^ription of {0} frame is known with respect to {U} frame, we 
can get the description of any frame {n} with reg^ect to {U} frame as 

U rp u rp Q rp 

~ 0^ AT-^ 

Now, we know the co-ordinatffi of any point on the boundary of the link- 
body in the link frame since the pb-sical dimensions of the link, like base 
radius and its length, are known (from user input). Apphing the transfor- 
mation we get the same co-ordinates with respect to the {U} frame. 
Thus we have the address of the cells belonging to the boundary of a partic- 
ular link of the manipulator with respect to the {U} frame. These cells are 
flagged as liik[i] belonging to the i-th link of the manipulator. In this way 
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cells belonging to the boundary of all the links of the manipulator are flagged. 
Now, since the cells belonging to the boundary of any link of the manipulator 
are knowm, it is checked whether they belong to a workcell obstacle, workcell 
boundairy or any other link-boundary of the manipulator. 

3.3.6 Storing configurations 

As and when the intersections are detected, they are stored in separate data 
files depending on the type of obstacle. Configurations for which no intersec- 
tions are detected are stored as ‘free’ configurations. A feasible path passes 
through these free configurations only. 

It may be observed that, through the above method, we get all points 
lying inside the C-obstacle while only boundary points would suffice for repH 
resentation of the C-obstacles. In this context, it may be mentioned that get- 
ting boundary points of the C-obstacles by identifying configurations, where 
link-boundaries are tangent to any of the obstacles, requires a great deal of 
effort on the part of the programmer^, whereas it is quite simple to iden- 
tify a boundary point by making sure that all its 3” — 1 neighbors are not 
C-obstade points. This identification of boundary points can be made by 
carrying out an independent search among all the C-obstacIe points. 

3.3.7 Identifying separate C-obstacles 

As and when an obstacle point is encountered, a check is made in the n- 
dimensional C-space whether any of its neighbours has been encountered (as 
an obstacle point) before or not. If yes, the concerened point is included 
in the same C-obstacle, else it is taken to be the first point of the next 
C-obstacle. Though this method makes sure that the obtained C-obstacles 
do not overlap, occasionally it is possible that a single C-obstacle may be 
reported as two or more. 

For an n-dimensional point P{xi,X 2 j. . . iXn) all points between P(xi — 
1, X 2 — ■ j 2:^ ~ 1) and P{xi -f 1 , 2:2 -f 1, . . . , -f 1) are taken to be its 

neighbours i.e. each n-dimensional point has 3” — 1 neighbours. 

®or the user of the output of the present work in any context 
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JOINT variables 


Figure 3.5: Neighbours in C-space 

In Figure 3.5, the thick line represents a configuration. All configurations 
lying between the dashed lines are tahen to be neighbours for this configura- 
tion. 

All separate C-obstacles are reported in different (output) data files. 

3.3.8 Algorithm 

Purpose: Mapping obstacles from Cartesian space to Configura- 
tion space 

Input: Room 

- dimensions 
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- resolution factor 
Obstacle 

- description 

- position 

- orientation 
Manipulator 

- D-H parameters 

- physical dimensions of links 

- position and orientation of base 

Output: (i) Points in C-space representing obstacles and free 
configurations. 

(ii) C-obstacles 


Steps: 

1. Divide room into equal sized cubes. 

2. Get point on room boundary x y z j 
flag cell(x, y, z) = boundary 

3. for (each obstacle) 

(i) for (whole body of each primitive) 

(a) get point on its boundary in its local frame 

Pt^prim} — ^ 3: y Z j 

(b) transform point to {U} 

Pt{U} = obs^ prim^ Pt{prjm} 

(c) flag cell(x, y, z) = obstacle 

4. for (each cell) 

(i) if (flag cell(x, y, z) ^ boundary and flag cell(x, y, z) ^ obstacle) 
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flag cell(x, y,z) = empty 


0. i <— 1 

call function recursive(z); (defined below) 

(i) for (joint i) 

(a) for (6 = 0 to 6 = steps) 

0i = Slower ^ 

(b) if {i < total number of joints) 
call function recursive(i + 1); 

(c) for (i = 1 to i = total number of joints) 
calculate matrix fT 

(d) for (whole body of link i) 

(1) get a point on its boundary in its local frame 

(2) transform point to {U} 

^hu} = fT = [ a: y (say) 

(3) if (flag cell( 2 :, y, z) = boundary) 
report intersection 

(4) if (flag cell(x, y, z) = obstacle) 
report intersection 

(5) if (i > 2) 

if (flag cellar, y, z) = any of link]0] to link[i-2j) 
report intersection 

(6) if (flag cell(a:, y, z) = empty) 
flag cell( 2 :, y, z) = lmk[i] 

(7) if (intersection reported) 

(a) if (neighbour in C-space is obstacle) 
include in same C-obstacle 

(b) else 

include in next Cobstacle 


^ripper Slower 

steps 
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(8) if (intersection not reported) 
report no intersection 
(e) for (i = 1 to i = total number of joints) 
if (cell{x, y, z) = link[i]) 
flag cell(Xj y, z) = empty 
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Chapter 4 

Inverse Kinematics 


The problem of sohing the kinematic equations of a manipulator is a non- 
linear one. Given the numerical value of %T we attempt to find \alues of 

01,02j • ■ • ,^n- 

For the case of an arm with 6 degrees of freedom we have 12 equations 
and 6 unknowns. However from the 9 equations arising from the rotation 
matrix portion of gT, only 3 equations are independent. These added with 
3 equations from the position vector portion of gT give 6 equations with 6 
unknowns. Th^ equations are non-linear, transcendental equations which 
can be quite difficult to solve. 

For the case of manipulators with still higher degrees of freedom, closed 
form solutions are not possible. 

4.1 Hyper- Redundant Manipulators 

The problem of inverse kinematics is stated as follows: 

Given a particular position and orientation of the end-effector of 
the manipulator, find the sets of joint variables which give rise to 
that particular petition and orientation of the end-effector. 

For hyper-redundant manipulators, the degrees of freedom is quite high, 
so infinite solutions exist. In this work, we use GA to solve the inverse 
kinematics problem applying the concept of ‘niching and speciation’. 
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4.2 Genetic Algorithms 


Genetic algorithms are search algorithms based on the mechanics of natural 
selection and natural genetics. They combine survival of the fittest among 
string structures with a structured yet randomized information exchange to 
form a search algorithm wdth some of the innovative flair of human search. In 
every generation a new set of artificial creatures (strings) is created using bits 
and pieces of the fittest of the old; an occasional new part is tried for good 
measure. \Mxile randomized, GAs efficiently exploit historical information to 
speculate on new search points with expected improved performance. 

The GA is based on two biological phenomena: natural selection and 
sexual recombination. In this, the possible solutions to a problem are rep- 
resented as bit string. The GA maintains a population of bit strings, and 
reproduces them preferentially based on quality of solutions they represent. 
This is analogous to natural selection. 

A simple genetic algorithm that yields good results in many practical 
problems is composed of three operators: 

1. Reproduction 

2. Crossover 

3. Mutation 

Reproduction is a process in which individual strings are copied accord- 
ing to their objective function values, / (also called fitness function). 
Intuitively we can think of the function / as some measure of profit 
or goodness that we want to maximize. Copying strings according to 
their fitness values means that strings with a higher value have a higher 
probability of contributing one or more ofepring in the next genera- 
tion^. Once a string has been selected for reproduction, an exact replica 
of the string is made. This string is then entered into a mating pool, a 
tentative new population, for further genetic operator action. 

^This operator, of course, is an artificial version of natural selection. 
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Crossover may proceed in two steps after reproduction. First, members of 
the newly reproduced strings in the mating pool are mated at random. 
Next, eadi pair of strings undergoes crossing over as follows: an integer 
position k along the string is selected uniformly at random between 1 
and the string length less one [1,1— 1]- Two new strings are created 
by swapping all characters between positons k + 1 and I inclusively. 

Mutation plays a small but important role in genetic methods: it pre- 
vents the population from becoming completely uniform. As the op- 
timization process progresses, the population improves by converging 
on a relatively small area of the search space, this necessarily means 
that the population becomes less diverse. Mutation introduces small 
changes which allow optimization to explore itself. When the popula- 
tion is highly fit, most mutations are likely to be detrimental. However, 
they can expand the seaxdi space beyond what would be explored by 
crossover alone and this can occasionaly be beneficial. 

Genetic approach does not rely on problem-specific features. They have 
two basic requirements: possible solution should be represented in a way such 
that two parents can be combined to yield an offspring, and a method of 
evaluating solutions must be supplied. These properties make GA attractive 
for our work. 

4.3 Problem Formulation 

In this work, we are required to perform inverse kinematics using GA. Wb 
ha\'e framed this as an unconstrained optimization problem. The variables 
in this problem are the joint variables that we are trying to solve for. The 
\’alues of these variables in the final population will give the required joint 
variabte for the specified end-effector position and orientation. 

4.3.1 Objective function 

Let Zid^req be the required description of the end-effector frame with respect 
to the {U} frame and be the description based on the values of joint 
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variablos for an individual at a particular generation during the execution of 
the GA. The objective function has been framed as the dilference between 
the values of the elements of these two matrices. A scaling factor has been 
provided for (.he elenu’nts belonging to the rotation matrix {)art of these 
transformation matrices. 

If Qij be an element belonging to the matrix end^req and bij be an element 
belonging to the matrix ^^^Toa, the objective function is: 

f = k ^ \aij — bij I + ^ jaj4 — 6^4 j 
i=lj=l i-1 


where k is the scale factor determined experimentally. Thus, this is a mini- 
mization irroblem. 

The fitness function that we want to maximize is given below: 


4.4 Niching and Speciation 


In our problem, because of the hyper-redundancy, the function space is highly 
multimodal, i.e. we have infinite number of peaks. In such a scenario, it is 
very likely that the GA will converge to a single peak i.e. majority of the 
individuals in the final population will belong to any one of the numerous 
peaks. In a general case, we are interested in finding as many solutions as 
possible and that too in a diverse space. For this we apply the concept of 
niching and speciation. 

The specialization permitted by sexual differentiation is carried further 
in nature through speciation and niche exploitation. Intutively w^e may view 
a niche as an organism’s job or role in an environment, and we can think of 
a species as a class of organism with common characterstics. 

In case of multimodal problems (see Fig 4.1), if we start from an initial 
population chosen uniformly at random, we obtain a relatively even spread of 
points across the function domain. As reproduction, crossover and mutation 
proceed, the population climbs the hills, ultimately distributing most of the 
strings near the top of one hill among the several. This ultimate convergence 
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on one peak or another without differential advantage is caused by genetic 
drift - stochastic errors in sampling caused by small population sizes. (Refer 
page 185 of Goldberg [14]) 



0.0 Qj 1.0 


Figure 4.1: Equal Peaks 
4.4.1 Theory of niche and species 

In such multimodal problems, instead of assigning the usual fitness to all 
individuals, eadi individual is forced to share the fitness of all the other 
individuals in its species. The incorporation of forced sharing discourages 
crowding of the population at a particular peak and causes the formation of 
stable sub-populations (species) at difi'erent peaks (niches). Furthermore, the 
number of individuals devoted to each niche is proportional to the expected 
niche payoff. 

A practical scheme that dir«:tly uses the sharing metaphor to induce niche 
and species is detailed by Goldberg and Richardson [15]. In this scheme, a 
sharing function is defined to determine the neighbourhood and degree of 
sharing for each string in the population. 
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4.4.2 Sharing function method 

For a given individual the degree of sharing is determined by summing the 
sharing function values contributed by all other strings in the population. 
Strings close to an individual require a high degree of sharing (close to one), 
and strings far from the individual require a very small degree of sharing 
(close to zero). After accumulating the total number of shares in this manner, 
an individual’s derated fitness is calculated by talcing the potential fitness 
(the unshared value) and dividing through by the accumulated number of 
shares. 

Given a set of Uk solutions in the A:-th generation [ 16 ] each having a 
dummy fitness value fk, the sharing procedure is performed in the folowing 
way for each solution i = 1 , 2 , . . . , 71^: 


Step 1 : Compute a normalized Euclidean distance measure with another 
solution j in the k-ih generation as follows: 


rfii - 


P 

E 

p=i 



where P is the number of variables in the problem. The parameters and 
Xy are the upper and lower bounds of variable x^. 


Step 2 : This distance dij is compared with a pre-specified parameter CshaTe 
and the following Staring function value is computed: 


Sh{dij) = 


0, otherwise. 


Step 3 : Increment j. If j < nk go to Step 1 and calculate Sh{dij). K 
j > Uk, calculate niche count for i-th solution as follows: 

mi-Y. 

3=1 
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Step 4: Degrade the dummy fitness /* of i-th solution in the k-th generation 
to calculate the shared fitness fl, as follows; 



This procedure is continued for each i = l,2,...,njfc and a corresponding 
value // is found. 

The above sharing procedure requires a pre-specified parameter ashore [16] 
which can be calculated as follows; 

0.5 

ashore 

Thus when many individuals are in the same nd^bourhood, the>' con- 
tribute to one another’s share count, thereby derating one another’s fitness 
\’alues. As a result, this mechanism limits the uncontrolled growth of partic- 
ular species within a population. 

4.5 Solution Clusters 

It has been said before that because of hj'per-redundancy, the function space 
is hi^y multimodal and the sharing function method is used to get stable 
sub-populations at difierent peaks. What it means is that most of the indi- 
viduals in the population which we will have in the final generation wiU be 
in ‘clusters’ or crowds. It is expected that many solutions wiU have 9's which 
differ by a small amount, i.e. there will be a cluster around a particular \nlue 
of 9. There will be a number of such clusters. Some stray individuals are 
also expected because of mutation. 
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Chapter 5 
Results 


Computer programs were ■mitteD for: 

1. (a) Mapping obstacles 

(b) Getting separate C-obstacles 

2. Getting inverse kinematic solutions 

The programs have been written in C++ for mapping obstacles and get- 
ting separate C-obstacles. For inverse kinematics solution, source code for a 
real-osded simple genetic algorithm was obtained from the Kanpur Genetic 
Algorithms Lab (KanGAL), Deptt. ofMech. Engg., IIT Kanpur. The objec- 
tive fsnction was coded, and nicking and spedation was incorporated using 
the Sharing Function. 

The programs have been run for basically two types of hyper-redundant 
manipulators: planar and spatial. Although the results are shown for one 
of each tj’pe, the program is a general one and can be used for mapping 
obstacles for a manipulator having any number of degrees of freedom. 

5.1 Description of Figures 

Although it is not possible to show the complete description of C-space since 
it is n-dimensional and it is not possible to show an n-dimensional point on 
a 2-D graph, we have tried to give some idea of the C-space by plotting two 
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two kinds of j)lots. To illustrato tlio idoa, mi oxmniilo of a. planar 3-DOF 
inaiiipulator is presented here. 'I’he workeell is rouglily shown in Fig 5.1. 



Figure 5.1: Workcell for 3-DOF mauipulator 

Although the manipulator is not redundant, the plots have been presented 
to convey some idea about the C-space. One (Polyline type) is for depicting 
boundary points, self-intersection points, obstacle points and free points. The 
other (Projection type) is used for showing separate C-obstacles. 

5.1.1 Polyline plot 

Here we plot each n-dimcnsional point as a polyline. The joint variables 
themselves have been shown along the X-axis (located at equal intervals) and 
their magnitude along the Y-axis. The magnitudes have been normalized as: 

Oi Slower 
^ Upper Slower 

For prc.sentation purposes, the interval between the limits of the joint vari- 
ables has been kept low. 

Eacli polyline starting from 0i through represents one configuration 
of the manipulator (or one point in the 7i-dimensional C-space). For each 
type of obstacle we get a series of such configurations which have been shown 
as plots. Plots of free configurations have also been shown. The plots have 
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been (Inuvu ill OpdiiGL. Fig 5.2 shows tlio jiolyliiu' plot for the iilanar 3-DOF 
luaiiipulator. Here three C-obstacles have been shown. 



1 

0 , 6 , 03 


Figure 5.2: Polyline plot for 3-DOF manipulator 

One limitation of this output plot is that with large number of data points 
and/or complicated shape of the C-obstacle, the plots become exticmely jum- 
bled, defying any interpretation. In such a situation an indirect assessment 
can be made by the following alternative output. 

5.1.2 Projection plot 

Here we have tried to use a concept akin to isometric projection. The axes 
are located at equal angles to each other where angle a = ^ (n = degrees 
of freedom). The co-ordinates (x, y) of any n-dimensional point on this 2-D 
grai)h is given liy 

/ 1 — / eos(()) + 0-2 cos(a) + 0^ cos( 2 a) + O.i (•os(3n) -1 P f/, ('os({n — 1 )«) \ 

I ?/ j ~ I 0i sin(O) -t- B 2 sin(a) + 0^ sin(2a) + 6*4 sin(3a) H P sin((n — l)a) j 

Thus, each 7 i-dimensional point is represented here as a projected 2-D point. 

The 0 values arc normalized. 

The idea here is to have some a posteriori verification that C-space points 
reported as a C-obstacle are actually contiguous. It can be argued that orig- 
inally non-contiguous points also may appear contiguous in the projection. 
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To alleviate such possibilities, various projections are tried by cyclic permu- 
tations of the axes. Contiguity of points in all these projections gives a strong 
evidence of the contiguity of the original points. Fig 5.3 is the projection plot 
for the planar 3-DOF manipulator. Two plots have been shown as just two 
permutations of the axes are possible. 




Figure 5.3: Projection plots for 3-DOF manipulator 

For higher dimensional cases, we have shown such plots for 4 permutations 
of the n axes. The index for the axes have been shown in the figure. The 
plots have been drawn in MATLAB. 
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5.2 Mapping Obstacles and Getting C-obstacles 

For mapping obstacles, the program has been run for a 5-DOF planar manip- 
ulator and an 8-DOF sjjatial hyper-reduiidant manipulator. For eacli type, 
we show the results for two different workcells. The separate C-obstacles 
have been shown for planar cases only. 

For planar cases, the implementation is in spatial form itself where the 
third dimension (breadth), wherever it appears, is a dummy one. 

5.2.1 Planar 5-DOF hyper-reduiidaiit manipulator 

Description of manipulator 


Joint 

Type 

Cti-i 

ai-i 

di 

di 

Length 

Limits 

1 

Revolute 

0 

0 

0 

Ox 

8.0 

10 350 

2 

Revolute 

0 

8.0 

0 

0-2 

8.0 

10 350 

3 

Revolute 

0 

8.0 

0 

^3 

8.0 

10 350 

4 

Revolute 

0 

8.0 

0 

0, 

8.0 

10 350 

5 

Revolute 

0 

8.0 

0 

0, 

8.0 

10 350 


Base radius of base link ; 4.0 
Radius reduction ratio : 0.997 

Workcell 1 

Dimensions (length, height, breadth) : 100 100 100 
Resolution Factor : 1.0 

Number of obstacles : 2 

For obstacle 1 

Frame origin co-ordinates wrt {U} frame : 5 5 5 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of primitives : 2 

For primitive 1 

Type : parallelepiped 

Length : 10 
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Height : 5 
Breadth ; 8 

Frame origin co-ordinates wrt obstacle frame : 3 0 3 

Frame orientation wrt obstacle frame (IIPY angles) : 0 0 0 

For primitive 2 

Type : cylindrical 

Inner Radius ; 2 

Outer Radius : 5 

Start Angle : 40 

End Angle : 280 

Length : 15 

Frame origin co-ordinates wrt obstacle frame : 8 5 C 
Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For obstacle 2 

Frame origin co-ordinates wrt {U} frame : 35 5 5 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of primitives : 1 

For primitive 1 

Type ; parallelepiped 

Length : 5 

Height ; 5 

Breadth : 5 

Frame origin co-ordinates wrt obstacle frame : 0 0 0 
Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

Position and orientation of manipulator 

Frame origin co-ordinates wrt {U} frame : 25 10 10 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of steps between limits of joint variables : C 

The given workcell is roughly drawn in Fig 5.1 


38 



Total C-obstacles detected = 15. 

Here, some of the significant C-obstacles have been shown. 



Figure 5.4: Workcell 1 (5-DOF, Planar) 



Figure 5.5: 5-DOF Workcell 1 Boundary Configurations 
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Figure 5.6: 5-DOF Workcell 1 Self-intersection Configurations 



0 , 6 , 04 0 , 


Figure 5.7: 5-DOF Workcell 1 Obstacle 1 Configurations 
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e, e, 6, 6. 0, 


Figure 5.8: 5-DOF Workcell 1 Obstacle 2 Configurations 



6, 6, e, s. e, 

Figure 5.9: 5-DOF Workcell 1 Free Configurations 
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Tlio polyline plots show the different obtained configurations. From the 
plots it is evident that there are a lot many couligurutions of the manipulator 
in which it hits all kinds of obstacles, while the free configurations are much 
less. The plot for free configurations is sparse as compared to the other ones. 

It must also be noted that although plots for different cases may look 
the same, they are not because a lot many combinations of 0’s overlap each 
other and cannot be told from each other. Thus, as told earlier, it is not a 
complete representation and is just an attempt to convey some idea of the 
C-space, especially the connectedness of individual C-obstacles. 
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Figure 5.11: 5-DOF AVorkcell 1 C-obstacle 2 
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Figure 5.12: 5-DOF Workcell 1 C-obstacle 3 
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Figure 5.13: 5-DOF Workcell 1 C-obstacle 4 
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Figure 5.14: 5-DOF Workcell 1 C-obstacle 5 
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Figure 5.15: 5-DOF Wbrkcell 1 C-obstacle 6 
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The plots depicting C-obstacles have been shown for four different per- 
mutations of axes’ location. This has been done to convey contiguity infor- 
mation regarding the C-obstacles. It may happen that non-contiguous points 
are reported as contiguous in one projection, but if they are shown as con- 
tiguous in all four projections, it is very likely that the C-obstacle is actually 
contiguous. 

From the shown plots it is evident that all obtaineil C-obstaeh^s are con- 
nected, i.e. points belonging to a (reported) C-obstacle are indeed contigu- 
ous. It might be noticed that some of the C-obstacles are very small, con- 
sisting of a small number of sampled points. These are mostly C-obstacles 
resulting out of self-intersection of the manipulator and , though small, offer 
significant hindrance to path planning. 
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Workcell 2 

Dimensions (length, height, breadth) : 200 200 200 
Resolution Factor : 1.0 

Number of obstacles ; 2 

For obstacle 1 

Frame origin co-ordinates wrt {U} frame : 100 60 100 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of primitives : 3 

For primitive 1 

Type ; parallelepiped 

Length ; 10 

Height : 10 

Breadth : 10 

Frame origin co-ordinates wrt obstacle frame : 0 0 0 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For primitive 2 

Type ; cylindrical 

Inner Radius : 0 

Outer Radius : 5 

Start Angle : 0 

End Angle : 360 

Length : 10 

Frame origin co-ordinates wrt obstacle frame : 5 10 5 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For primitive 3 

Type ; parallelepiped 

Length ; 10 

Height : 10 

Breadth : 10 

Frame origin co-ordinates wrt obstacle frame : 0 20 0 
Frame orientation wrt obstacle frame (RPY angles) . 0 0 0 
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For obstacle 2 

Frame origin co-ordinates wrt {U} frame : 140 70 110 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of primitives : 1 

For primitive 1 

Type : cylindrical 

Inner Radius : 5 

Outer Radius ; 10 

Start Angle : 10 

End Angle : 350 

Length : 20 

Frame origin co-ordinates wrt obstacle frame : 0 0 0 
Frame orientation wrt obstacle frame (RPY angles) ; 0 0 0 

Postion and orientation of manipulator 

Frame origin co-ordinates wrt {U} frame : 120 40 110 

Frame orientation wrt {U} frame (RPY angles) : 0 0 90 

Number of steps between limits of joint variables : 6 

The given workcell is roughly drawn in Fig 5.17 
Total number of C-obstacles detected = 79 
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Figure 5.20: Workcell 2 (5-DOF, Planar) 



6, a, 8, e, e, 


Figure 5.21: 5-DOF Workcell 2 Boundary Configurations 

Here, from the plot for boundary configurations, it can be seen that for 
given limits on the joint variables, the manipulator hits the workcoll boundary 
for a very few number of configurations and those configurations relate to the 
limiting values of (Ps. Also, the plot for obstacle 2 in this case, is a sparse 
one indicating that the manipulator does not hit it too often. 

From the plots for C-obstacles (10 of them are reported here), it can be 
seen that all of them are contiguous ones. 
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0, Oj 0, O4 6, 


Figure 5.22: 5-DOF Workcell 2 Self-intersection Configurations 
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Figure 5.23: 5-DOF Workcell 2 Obstacle 1 Configurations 
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Figure 5.24: 5-DOF Workcell 2 Obstacle 2 Configurations 



JOINT VARW.mX.'S 


Figure 5.25; 5-DOF Workcell 2 Free Configurations 
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Figure 5.27: 5-DOF Workcell 2 C-obstacle 2 
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- 3 - 2-10123 - 3 - 2-10123 

Figure 5.30: S-DOF Wbrkcell 2 C-obstacle 5 
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Figure 5.33: 5-DOF AVorkcell 2 C-obstacle 8 
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Figure 5.35: 5-DOF Workcell 2 C-obstacle 10 
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5.2.2 Spatial 8-DOF hyper-redundant manipulator 

Description of manipulator 


Joint 

Type 

ai^i 


di 

Oi 

Length 

Limits 

1 

R.evoiute 

0 

0 

0 

Oi 

24.0 

0 360 

2 

Revolute 

-90 

0 

0 

02 


-225 45 

3 

Revolute 





■ejilH 

-135 135 

4 

Prismatic 




■■ 

18.0 

-8 0 

5 




ds 



29 34 

C 

R.evoiute 

-90 

0 

il 


■ijnH 

-180 0 

7 

Revolute 

0 

14.0 

0 

67 

12.0 

-90 90 

8 

Prismatic 

90 

12 

^8 

0 

10.0 

-5 0 


Base radius of base link : 5.0 
Radius reduction ratio : 0.997 


Workcell 1 

Dimensions (length, height, breadth) : 200 200 200 
Resolution Factor : 1.0 


Number of obstacles : 3 

For obstacle 1 

Frame origin co-ordinates wrt {U} frame : 80 40 70 

Frame orientation wrt {U} frame (RPY angles) : 0 90 0 

Number of primitives : 3 

For priniitiv(; 1 

Type : parallclopiped 

Length : 15 

Height : 5 

Breadth ; 5 

Frame origin co-ordinates wrt obstacle frame . 0 0 0 
Frame orientation wrt obstacle frame (RPY angles) .000 
For primitive 2 
Type : parallclopiped 
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Length : 10 
Height ; 5 
Breadth : 5 

Frame origin co-ordinates wrt obstacle frame : 0 5 0 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For priinitive 3 

Type : paraliclopiped 

Length : 5 

Height : 5 

Breadth : 5 

Frame origin co-ordinates wrt obstacle frame : 0 10 0 
Frame orientation wrt obstacle frame (RPY angles) : 0 45 0 

For obstacle 2 

Frame origin co-ordinates wrt {U} frame : 100 10 30 

Frame orientation wrt {U} frame (RPY angles) : 90 0 90 

Number of primitives : 2 

For primitive 1 

Type : cylindrical 

Inner Radius : 0 

Outer Radius : 10 

Start Angle : 0 

End Angle : 360 

Length : 20 

Frame origin co-ordinates wrt obstacle frame : 10 0 10 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For primitive 2 

Type ; cylindrical 

Inner Radius : 3 

Outer Radius : 0 

Start Angle : 10 

End Angle : 200 

Length : 15 
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prame origin co-ordinates wrt obstacle frame : 10 20 10 
Frame orientation wrt obstacle frame (RPY angles) ; 0 0 0 

For obstacle 3 

Frame origin co-ordinates wrt {U} frame : 150 40 70 

Frame orientation wrt {U} frame (RPY angles) : 0 0 45 

Number of primitives ; 2 

For primitive 1 

Type ; paralielo|)iped 

Length : 20 

Height : 10 

Breadth : 10 

Frame origin co-ordinates wrt obstacle frame : 0 0 0 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 90 

For primitive 2 

Type : (cylindrical 

Inner Radius ; 8 

Outer Radius : 10 

Start Angle : 0 

End Angle : 300 

Length : 20 

Frame origin co-ordinates wrt obstacle frame : 5 20 5 
Frame orientation wrt obstacle frame (RPY angles) : 0 0 -90 

Postion and orientation of manipulator 

Frame origin co-ordinates wrt {U} frame : 80 30 30 

Frame orientation wrt {U} frame (RPY angles) : -90 180 0 

Number of steps between limits of joint variables : 4 


71 




0, 8a 6, e, e, 6, 0 , 


p’ignK' 5.30; 8-DOF Workcell 1 Boundary Configurations 



0, e, 6, 0. e, e. e, ' e. 


Figure 5.37: 8-DOF Workcell 1 Self-intersection Configurations 

From the plots it can be made out that for most of the values of 6i,02 
and <?3 the manipulator does not hit any obstacle. Also, a large number of 
free configurations are available. 
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e, 6, e, e, 0 , e, e, e, 


Figure 5.40: 8-DOF Workcell 1 Obstacle 3 Configurations 



Figure 5.41: 8-DOF Workcell 1 Free Configurations 
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Workcell 2 

Dimensions (length, height, breadth) : 200 200 200 
Resolution Factor : 1.0 

Number of obstacles : 2 

For obstacle 1 

Frame origin co-ordinates wrt {U} frame : 50 70 30 

Frame orientation wrt {U} frame (RPY angles) ; 0 90 0 

Number of primitives : 2 

For primitive 1 

Type : parallelepiped 

Length : 15 

Height : 5 

Breadth : 5 

Frame origin co-ordinates wrt obstacle frame : 0 0 0 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For primitive 2 

Type ; parallclopiped 

Length : 10 

Height : 5 

Breadth : 5 

Frame origin co-ordinates wrt obstacle frame : 0 5 0 
Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For obstacle 2 

Frame origin co-ordinates wrt {U} frame : 130 50 60 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Number of primitives : 2 

For primitive 1 

Type : cylindrical 

Inner Radius ; 0 

Outer Radius : 10 
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Start Angle : 0 
End Angle : 3G0 
Length : 10 

Frame origin co-ordinates wrt obstacle frame : 10 0 10 

Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

For primitive 2 

Type : cylindrical 

Inner Radius ; 0 

Outer Radius : 6 

Start Angle : 10 

End Angle : 200 

Length : 5 

Frame origin co-ordinates wrt obstacle frame : 10 10 10 
Frame orientation wrt obstacle frame (RPY angles) : 0 0 0 

Postion and orientation of manipulator 

Frame origin co-ordinates wrt {U} frame ; 80 30 30 

Frame orientation wrt {U} frame (RPY angles) : -90 180 0 

Number of steps between limits of joint variables : 4 




e, 0 , 6, 6, 6, 6, 6, e. 

Figure 5.42: 8-DOF Workcell 2 Boundary Configurations 



Figure 5.43: 8-DOF Workcell 2 Self-Intersection Configurations 

The plots show that for most values of 61,62 and 6 z, the manipulator 
does not hit any obstacle. There are a lot of configurations in which the 
manipulator hits itself or the workcell boundary. A large number of free 
configurations are also shown. 
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Figure 5.44: 8-DOF Workcell 2 Obstacle 1 Configurations 


KMKT VARIABUIS 

Figure 5.45; 8-DOF Workcell 2 Obstacle 2 Configurations 
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0, 6j 63 04 0J 6, 67 0, 

Figure 5.46; 8-DOF Workcell 2 Free Configurations 
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5.3 Inverse Kinematic Solutions 

Inverse kiiieniatics has been performed for the same 5-DOF planar and 8- 
DOF spatial hyper-rcdnndant manipulators. For each of them, results for 
two sets of end-effector poses are reported here. 

5.3.1 Planar 5-DOF hyper-redundant manipulator 


Joint 

Type 

Oi-l 

ai-i 

di 


Length 

Limits 

1 

Revolute 

0 

0 

0 

ex 

8.0 

10 350 

2 

Revolute 

0 

8.0 

0 

02 

8.0 

10 350 

3 

Revolute 

0 

8.0 

0 

^3 

8.0 

10 350 

4 

Revolute 

0 

8.0 

0 

0, 

8.0 

10 350 

5 

Revolute 

0 

8.0 

0 

05 

8.0 

10 350 


Case 1 

Population size : 300 
Number of generations : 500 
Distribution index for crossover ; 25 
Distribution index for mutation : 100 
Crossover probability : 0.9 
Mutation probability : 0.009 
Random seed : 0.7654321 

Position and orientation of manipulator base frame 
Frame origin co-ordinates wrt {U} frame : 100 10 100 
Frame orientation wrt {U} frame (RPY angles) ; 0 0 0 
Position and orientation of end-effector frame 
Frame origin co-ordinates wrt {U} frame : 100 60 100 
Frame orientation wrt {U} frame (RPY angles) : 0 0 0 
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Figure 5.47: Solution Clusters for 5-DOF Case 1 



Figure 5.48: Solution Clusters for 5-DOF Case 1 
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Case 2 

Population size : 300 

Number of generations : 500 

Distribution index for crossover ; 25 

Distribution index for mutation : 100 

Crossover probability : 0.9 

Mutation probability : 0.009 

Random seed ; 0.7654321 

Postion and orientation of manipulator base frame 

Frame origin co-ordinates wrt {U} frame : 100 10 100 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 

Postion and orientation of end-effector frame 

Frame origin co-ordinates wrt {U} frame : 80 50 100 

Frame orientation wrt {U} frame (RPY angles) : 0 0 0 



Figure 5.49: Solution Clusters for 5-DOF Case 2 

From the plots it can be made out that the solutions tend to crowd around 
some values of 0’s. These arc the solution ‘clusters’ discussed before. Some 
of the stray solutions arc irresent because of the mutation operator lused in 
GA. 

The solutions provided here are for workcells which do not have aiiy ob- 
stacles. For a particular pose of the end-ellector, this gives us C-sj)ace points 
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Figure 5.50: Solution Clusters for 5-DOF Case 2 

in the inverse kinematics solutions’ region. When C-obstacles are present, 
the solution cluster may lie wholly outside, wholly inside or partly inside the 
C-obstacle. This gives us information about the feasibility of the obtained 
inverse kinematic solutions. 
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5.3.2 Spatial 8-DOF hyper-redundant manipulator 






El 

Oi 



1 

R,o volute 

0 

0 

0 

wm 



2 

Ilevolute 

-90 

0 

El 

mm 


-225 45 

3 


■1 


El 


IBIH 

-135 135 

4 

Prismatic 

■■ 





-8 0 

5 

Prismatic 

0 

0 

(is 

-90 


29 34 

6 

Revolute 







7 

Revolute 

0 





-90 90 

8 






10.0 

-5 0 


Case 1 

Population size : 300 
Number of generations : 500 
Distribution index for crossover : 25 
Distribution index for mutation : 100 
Crossover probability : 0.9 
Mutation probability : 0.009 
Random seed ; 0.7654321 

Postion and orientation of manipulator base frame 
Frame origin co-ordinates wrt {U} frame ; 80 30 30 
Frame orientation wrt {U} frame (RPY angles) : -90 180 0 
Position and orientation of end-effector frame 
Frame origin co-ordinates wrt {U} frame : 80 50 60 
Frame orientation wrt {U} frame (RPY angles) : 0 0 0 
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Figure 5.51: Solution Clusters for 8-DOF Case 1 




Figure 5.52: Solution Clusters for 8-DOF Case 1 
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Case 2 

Population size : 300 

Number of generations ; 500 

Distribution index for crossover ; 25 

Distribution index for mutation : 100 

Crossover probability : 0.9 

Mutation probability : 0.009 

Random seed : 0.7654321 

Postion and orientation of manipulator base frame 

Frame origin co-ordinates wrt {U} frame ; 80 30 30 

Frame orientation wrt {U} frame (RPY angles) : -90 180 0 

Postion and orientation of end-effector frame 

Frame origin co-ordinates wrt {U} frame : 120 60 30 

Frame orientation wrt {U} frame (RPY angles) : -90 0 0 



JOINT VARIABtES 


Figure 5.53; Solution Clusters for 8-DOF Case 2 

Here also, the solutions tend to crowd around some values of ^’s as ex- 
pected. 
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Figure 5.54: Solution Clusters for 8-DOF Case 2 
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Chapter 6 

Conclusions and Future Scope 


6.1 Summary 

In the present work, attempt has been made to get the C-space represen- 
tation of hyper-redundant manipulators for 2-D and 3-D cases. The ob- 
tained C-space points are n-dimensional (n > 3). But since there is no- 
available technique for representing n-dimensioiial points, the results have 
been presented as 2-D graphs. Though not self-explanatory, they do convey 
information about the various types of configurations in the C-space. The 
contiguity of different C-obstuclcs can be seen in the projection type plots. 
The mapping that we have obtained in the various cases illustrated before is 
reasonably exhaustive if not complete. The density of points can be further 
increased by increasing the number of ‘steps’ though it becomes computa- 
tionally intensive. For presentation purposes, low values of ‘steps’ have been 
used. 

While getting C-obstacles, it is important to avoid overlapping of different 
C-obstacles. The same point should not be included in two separate C- 
obstacles. The representation of C-obstacles presented in this work is not 
complete, but it does solve the problem of overlapping. Instead of complete 
C-ob.sf.ac^lcH, wc may get fragments which belong to the same C-obstacle. 

The i)rocess of computing inverse kinematic solutions prcvsented in this 
work is simple to implement. As expected, we get solution clusters pertaining 
to different peaks in the function space. These solutions are good solutions 
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as long as the goal point lies inside the workspace of the manipulator. Points 
lying outside the workspace, can be detected by the very poor fitness of the 
solutions. 


6.2 Future Scope 

The present work opens up quite a few avenues for future continuations. It 
is one of the most important components for implementing path planning 
schemes which are based on C-space. For such planning schemes, a good 
description of the C-space is required, which this work provides. The inverse 
kinematics solutions can be used to get tentative solutions and they can be 
compared with the obtained description of the C-space to check for feasibility 
of obtained paths. 

The C-space description is roughly shown in Fig 6.1. In this figure, it can 
be seen that some solution sets lie wholly inside a C-obstacle, some lie wholly 
outside and some partly outside. The comparison between the two can be 
quantified by computing the ‘distance’ between the C-obstaclo points and the 
inverse kinematics solution points. Minimizing the interaction of C-obstacles 
aiifl Holiition olu.steiH, the dnsignor can .synthesize l)etter m!iuij)»iln(()is,TIuis 
this work provides the necessary foundation for path planning and synthesis. 



Figure 6.1: C-space 
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Appendix A 
Configuration Space 


A.l Configuration Space 


The Configuration space (C-space) of a manipulator is an n-dimensional 
space where each dimension represents one degree of freedom of the manip- 
ulator. For example, let us consider a manipulator having 10 joints, i.e. it 
has 10 degrees of freedom. Tlie C-space for this manipulator will be a 10- 
dimensional space where each dimension (axis) corresponds to each degiee 

of freedom of the manipulator. 

A point to note here is that a point in the C-space of a manipulate 
actually repreacuts the (uuique) couflguratio.. that the .uampulator taket u. 
the 3-dimeusioual Cartesian space. Conversely, every cenfiguratron of 
manipulator in the 3-D Cartesian space maps to a point in rt, aspace. 


A.2 Configuration 


We consider a rigid object A the robot, nroving in a 

(See Fig A 1). We represent W as the N-dimensional Euchdean sparse , 

L N = 3 equipped with a fixed Cartesian system or frame denoted by 

r we represent A at a reference position and orientation a, a compact 

subset of if". A moving frame is attaclred to ^ so th^^e^^ 

robot has fixed co-ordinates in 3^^. The ongms o w ^ „,i„,,tion of 

by Ow and Ox respectively. So a couf.gurat.ou q A 

the positiou and oriclation of wHh 
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space of A is the sapce C of all possible configurations of A. 

A configuration q of ^ can be bijectively represented, in a way that 
depends upon the choice of the frames and as a pair (T,©), where 
T determines the position of the origin of in and 0 determines 
the orientation of ^^’s axis with respect to J>v- 

L(!t us adopt the following convention: T is e(iual to A-vector of tlu' co- 
ordinates of in and 0 is equal to N x N matrix whose columns arc 
the components of the unit vector along ^^’s axis in 



w 


Figure A.l: The robot moves in a workspace W = , {N = 3). A is modeled 

as a compact subset of A fixed Cartesian frame Tw is embedded in A. 
The configuration of A specifies the position and orientation ^ 4 with respect 
to 
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A. 3 Obstacles 


Let W contain fixed obstacles Bi = 1, 2, . . . which we represent as closed 
but not necessarily bounded [13] regions of . The Bi's denote both the 
physical obstacles and the subsets of that represent them. 

A.4 C-obstacles 

Definition; The obstacle Bi in W maps in C to region 

CBi = {qeC/Aiq)nBij^(l>} 

CBi is called C-obstacle. The union of all C-obstacles 

(jCBi 

i=l 

is called the C-obstacle region and the set: 

c,„, = c U CB, = I? e C/A(q} n (yj 

is called the free space. Any configuration in C/ree is called the free con- 
figuration. A free path between two free configurations qinit and qgoai is 
a continuous map r : [0, 1] — > Cfree, with r(0) = qinit and r(l) = qgoai- Two 
configurations belong to the same connected component of C free if and only 
if they are connected by a free path. 


92 



Appendix B 
Transformations 


B.l Roll, Pitch, Yaw Angles 

One method of describing the orientation of a frame {B} is as follows: 


Start with the frame coincident with a known reference frame 
{A}. First rotate {J5} about by an angle 7 , then rotate 
about Ya. by an angle 0, and then rotate about Za by an angle 
a. 



Refer Fig B.l. Each of the three rotations takes place about an axis in 
the fixed reference frame, {A}. We call this convention for specifying an 



orientation roll, pitch, yaw angles. Sometimes this convention is referred 
to as X-Y-Z fixed angles. The word “fixed” refers to the fact that the 
succesive rotations are specified about the fixed (i.e. non-moving) reference 
frame: 


= Rzia) Ry{P) Rxil) 



ca —sa 0 ' 


cP 0 sp ' 


'10 o' 


sa ca 0 


0 1 0 


0 ay —sj 


. 0 0 1 _ 


—sP 0 cP _ 


i 

0 

Co 

1 


Multiplying, we obtain 


B^xYzil, /?) Q:) = 


cacP 

sac/3 

-sp 


casPsj — sac') 
sasPsj + cac'y 
cPsj 


casPcTf + sasy 
sasPcTf — cq ; s 7 
c/?C7 


B.2 Denavit-Hartenberg Parameters 


Any robot can be described kinematically by giving the values of four quan- 
tities for each link. These four quantities are link twist (cvj-i), link length 
(aj-i), link offset (d,), and joint angle (dj). Two describe the link itself, and 
two describe the link’s connection to the neighbouring link. In the usual 
case of a revolute Joint, Oi is called the joint variable, and the otlu'r three 
quantitie.s would be fixed link parameters. For prismatic joints di is the 
joint variable and the other three quantities are fixed link parameters. The 
definition of mechanisms by means of these (}uantities is a convention usually 
called the Denavit-Hartenberg notation [12]. 


B.3 Link Transformations 

We wish to determine the transformation which defines frame {f} relative 
to the frame {i — 1}. For any given robot, this transformaton is a function 
of only one variable. By assigning a frame for each link we have broken the 
problem into n subproblems (for rj-linked robot) [12]. In order to .solve each 
of these subproblems, namely t~^T, we will further break the problem into 
four sub-subproblerns. we begin by defining three intermediate frames for 
each link namely: {P}, {Q}> and {/?}. 
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Figure B.2: Link Transformations 

Fig B.2 shows a pair of joints with frames {P}, {Q} and {R} defined. 
Frame {P} differs from frame {i — 1} only by a rotation of aj-i. Frame {Q} 
differs from {P} by a translation «j_i. Frame {P} diffcns from {Q} by a 
rotation 9i, and frame {f} differs from {P} by a translation di. If wo wish 
to write the transformation which transforms vectors defined in {i} (*P) to 
their description in {f — 1} (‘“^P) we may write, 

qT pX ^ P 

or 

i-ip^ i-ir‘P, 

where 

i—lrji i’—lrjp ^X 

Considering each of these transformations, we see that B.3 may be written 
as; 


(B.l) 

(B.2) 

(B.3) 


i)5 



PKltiplying the factors in B.4 we obtain the general form of ) as 

c6i -s9i 0 Oj-i 

sdicai-i c9icai-i -sai-i -soi-idi 
‘ ^ “ sOiSai-i cOiS(Yi-\ c(\i-i cxYi-idi 

U 0 0 1 
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Appendix C 
Input Format 


This is a sample input format for tiie program to map obstacles from 
Cartesian space to configuration space. 

Statements in bold appear as prompts during input, while the normal font 
is used to show the user input. Statements in italics are comments for the 
understanding of the reader. 

{0} frame is the fixed base frame of the manipulator. 


Input the room dimensions <length, height, breadth> in cm: 100 
100 100 

Input the resolution factor :2 

This factor determines the number of cells the workcell is to be divided in. It 
is multiplied with the value of each dimension to get the number of cells. A 
value of this factor more than 1 increases the resolution. For the above input 
the number of cells are : 

100 X 2 = 200 
100 X 2 = 200 
100 X 2 = 200 

Input number of obstacles (max 10) : 1 

Tim obstacles are made up of two kinds of pi-imitivcs : paruHelopiprd and 
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cylindrical. 

Consider yourself to be standing in front of the rectangular room. 
The universal frame is fixed to the far-bottom-left corner. Y-axis 
is from bottom to top, Z-axis points right at you and X-axis is from 
your left to right. 

For obstacle 1 
Give Position. 

Co-ordinates of the origin of its local frame wrt the universal frame 
: 5 5 5 

Give Orientation (RPY angles wrt universal frame). 

Rotation about X-axis : 0 
Rotation about Y-axis : 0 
Rotation about Z-axis : 0 
Number of primitives ; 2 

Enter data for primitive 1 

Press ‘p’ for parallelopiped or ‘c’ for cylindrical : p 
Give Dimousions. (In its local frame defined by you.) 

Length (along its X-axis) : 40 
Breadth (along its Z-axis) ; 20 
Height (along its Y-axis) : 30 
Give Position. 

Co-ordinates of the origin of its local frame wrt the obstacle frame 

: 5 5 5 

Give Orientation (RPY angles wrt obstacle frame). 

Rotation about X-axis : 0 
Rotation about Y-axis : 0 
Rotation about Z-axis : 0 

// (jiven oh.Htaclc internects with the boundary at the given potiition and ori- 
entation, the program stops. 

Enter data for primitive 2 

Press ‘p’ for parallelopiped or ‘c’ for cylindrical : c 
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A cylindrical obstacle can be from a full solid cylinder to a sector of a hollow 
cylinder. 

Angles are measured about the local Y-axis, with theta = 0 along 
the Z-axis. 

Give Diuicasious. 

Inner radius : 5 
Outer radius ; 10 

Start angle (between 0 and 360): 10 
End angle (between 0 and 360): 270 
Length (along Y-axis): 20 
Give Position. 

Co-ordinates of the origin of its local frame wrt the obstacle frame 
: 10 20 10 

Give Orientation (RPY angles wrt obstacle frame). 

Rotation about X-axis : 0 
Rotation about Y-axis : 0 
Rotation about Z-axis : 0 

Input the number of links of the manipulator (max 30) ; 3 

If link is not along any of the axes in its local frame, input a set of 
points giving the mid-line curve of the link. 

Input the D-H parameters for link 1 : 

Give file name containing set of points or press “go” to continue : 

go 

Revolute/Prismatic (R/P) •* r 

Length : 20 

alpha[0] : 0 

a[0] : 0 

d[l] : 0 

Limits on theta[l] : '15 270 
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For a non-interactive execution, the user inputs can be included in the cor- 
rect order in a file and submitted to the program. For the above example, 
the input file will be as given below. 


100 100 100 
2 
1 

5 5 5 
0 
0 
0 
2 

P 

40 

20 

30 

5 5 5 
0 
0 
0 
c 
5 

10 

10 

270 

20 

10 20 10 
0 
0 
0 
3 

go 
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20 

0 

0 

0 

45 270 
hot 
link2 
r 
0 

20 

0 

90 200 
go 

P 

25 

0 

5 

0 

10 5 
top 

X 

25 10 20 
90 
0 
0 
5 

0.997 

20 
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Appendix D 
Program Details 

Functions used for getting input data: 

• get_room : To get room dimensions. 

• get_obs : To get data regarding obstacles. 

• get-prims : To get data regarding primitives. 

• get_manip : To get data regarding the manipulator. 

• get-base ; lb get position and location of nianipulator base. 

Ail the above functions are called in main. 

Functions used for flagging cells: 

• flag-boundary : To flag cells belonging to workcell boundary. 

• flag-obs : To flag cells belonging to obstacles. 

• flag-empty : To flag cells belonging to free space. 

All the above functions are called in main 

Functions for performing the mapping 

• recursive : To generate configurations, compute intersections, identify 
different C-obstacles and to store them. It is called in main. 
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• matrices : To calculate different transformation matrices. It is called 
in recursive. 

• intersection : To compute intersections, identify separate C-obstacles 
and store them. It is called in recursive. 

• search : To search in C-space for identifying separate C-obstacles. It 
is called in intersection. 

• check : To check for neighbors in C-space. It is called in search. 

Other functions 

• matmult41 : To multiply transformation matrices with point vectors. 
It is called in main, flag.obs and intersection. 

• matmult44 : To multiply two 4x4 matrices. It is called in matrices. 

• makemat ; To construct a 4 x 4 transformation matrix. It is called in 
flag-obs. 

• rewind : To clear the workspace of cells flagged as belonging to the 
manipulator after each conliguration. it is called in recursive. 

• prnJist : To print C-obstacle points from linked list. It is called in 
intersection. 
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